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CHAPTER I - INTRODUCTION 



1.1 BACKGROUND 

During the several years spent in designing a submarine, a 
great deal of effort is expended trying to improve the design so that 
the best possible vessel is eventually constructed. During the de- 
sign phases the designer will frequently examine problems that were 
found in older submarines and try to determine the cause of each 
problem so that they can be eliminated in the new design. At several 
stages during the design, computer models are used to assist in such 
things as structural design, equilibrium calculations, and internal 
arrangement. As the design progresses, physical models of the 
proposed vessel are built and tested in a towing tank to measure the 
hydrodynamic coefficients. Finally, when it is possible to deal with 
the vessel as a whole, a dynamic analysis is conducted to gauge how 
the submarine will perform in an underwater environment when all six 
degrees of freedom are available. 

While it is possible to gather dynamic information, such as the 
hydrodynamic coefficients, from physical model tests, the models are 
necessarily too restricted in their motion to permit a complete 
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analysis. It is necessary to construct a mathematical model of the 
submarine to simulate the submarine's motion and thereby obtain 
enough data for a complete analysis. The simulation model will use 
the hydrodynamic coefficients obtained from the physical model as a 
basis for the simulation. A properly constructed model will permit 
the designer to simulate any conceivable maneuver and gauge the 
submarine's response. The simulation model then becomes a tool to 
assist in improving the design and achieving the best possible 
vessel. After the submarine is designed, the model can continue to 
be useful by assisting in the evaluation of operating procedures. 

The model can be placed in any maneuvering situation without hazard 
to crew or vessel. This is especially useful in evaluating casualty 
situations. The model can also be used to estimate the effect of 
proposed design changes to the submarine. For instance, the model 
can show the effect of changing the maximum deflection of a control 
surface or its rate of operation. 

All of the few six degree of freedom submarine simulation models 
in existence are too expensive for daily use in the design office. 
Generally, the models are complicated to use and sometimes difficult 
to obtain. These problems have created the need for a program that 
is both inexpensive enough to permit daily use in the design office 
and simple enough so that anyone can use it. This need has formed 
the motivation for this thesis. 

1.2 MODEL DEVELOPMENT 

A mathematical model must use Newton's Law of Motion and the 
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differential equations resulting from a dynamic analysis of the 
submarine. A submarine has movable appendages, so these must also 
be accounted for in the model. Newton's Law of Motion can be 
expressed as: 

(1) Force = ^ (momentum) 

(2) Moment = (angular momentum) 

If a submarine with a coordinate system such as shown in Figure 1 is 
used, then equation (1) can be applied along each of the three axes. 
Similarly, equation (2) can be applied around each axis. This gives 
a total of six equations to represent the six degrees of freedom of 
the submarine. These six equations of motion are well-known [1] so 
they are not developed in detail here. They are, however, included 
for reference in Appendix A. 

While the equations of motion for the submarine form the heart 
of the model, they are insufficient by themselves. On an actual 
submarine, the officer of the deck orders the rudder or dive planes 
moved in order to maneuver the ship. The routines will normally 
sense where the ship currently is and where it is supposed to be and 
then move the appendages in the appropriate direction just as the 
deck officer would do. The six equations of motion together with 
the appendage control subroutines constitute the vital components of 
the simulation model. A main program is necessary to coordinate the 
input, output, and to control the action of the subroutines. 

The components of the model are discussed in detail in Chapter 
II of this thesis. The model is written as a computer program whose 
features are discussed in Chapter III. The final chapter will 



discuss the model tests and their results. A listing of the 
program will be provided in Appendix B. 
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CHAPTER II - THE SIMULATION MODEL 
II. 1 GENERAL CAPABILITIES 

The simulation model developed in this thesis will provide 
trajectory information for routine submarine maneuvers such as 
turning or changing depth. The trajectory, which is referenced to 
a fixed coordinate system,. is computed as a function of time. As 
the trajectory of the model is developed, the velocities and 
accelerations are calculated and stored for output to the user. 

Both angular and linear velocities and accelerations are provided. 

The angle of deflection of each control surface appendage is computed 
for each step of the entire trajectory or maneuver. 

The rate of deflection of each control surface and its angle 
of maximum deflection are specified by the user. Any of the control 
surfaces can be "jammed'' by specifying a particular angle of 
deflection. The model can be initially placed on any course and 
depth and then ordered to come to any new course and depth. The 
user can select the initial speed and the appropriate thrust 
coefficients to cause a change in speed. 



I I. 2 COORDINATE SYSTEMS 
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The coordinate system plan used in the simulation model is 
based on [1]. The model uses two orthogonal coordinate systems; one 
remaining fixed at the water surface while the othef travels with the 
submarine to act as a local reference system. The fixed system, 
designated x Q , y Q , z Q , is related to the moving system, designated 
x, y, z, through the angles <f>, e , <A as illustrated in Figure 2. 
Quantities measured in the moving system can be referenced to the 
fixed system by using the transformation [2] given in Appendix A. 

The origin of the moving system is at the center of gravity of 
the submarine. This has the advantage that only the principal 
moments of inertia, I , I , I , are non- zero (i.e.: I Y *I v =I y _t 0). 
It has the additional advantage that the equations of motion in [1] 
also use this reference point for the x, y, z system. It would have 
been possible to use the centerline of the submarine for the origin. 
This would have the advantage of making better use of the symmetry 
of the vessel, however it would have the disadvantage of having to 
correct both the equations of motion and some of the hydrodynamic 
coefficients for the new origin. 

Appendage movements are measured with respect to the moving 
coordinate system. All velocities and accelerations are measured 
along the axes of the moving system. This is also shown in Figure 2. 

II. 3 EQUATIONS OF MOTION 

The general nature of the six degree- of freedom model requires 
the use of the six equations in their non-linear form. A large 
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Relationship of Axes j Angles^ Velocities; Forces, & Moments [l] 

Figure 2 
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number of hydrodynamic coefficients are necessary for this model. 

It would be desirable to derive each coefficient from existing hydro- 
dynamic theory. Some coefficients have been obtained for bodies of 
revolution or other mathematically amenable shapes however, when 
appendages such as control surfaces, fairwaters, and propellers are 
taken into account, the accuracy of the theoretical values is brought 
into question. For this reason it is standard practice to obtain the 
numerical value of the coefficients by experimental means. This 
usually entails the towing and measurement of physical models. 

Once the hydrodynamic coefficients are known, the equations 
can be solved for the accelerations. The six equations of motion 
must be written such that the highest order derivatives, namely 
u, v, w, p, q, r and their coefficients, appear on the left hand 
side of the equation. This gives each equation a form like: 

a i , j “ + a i J+l " + a i ,j+2 " + a i ,j+3 P + a i , j+4 < + a i ,j+5 ; ‘ 

f^ ( u , y > w, p, q, r, 0, y, § r , , 8^ » 1 . m, . . . ) 

The left hand side is placed in a matrix format. The six equations 
are then represented as: 
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The method of solution is an iterative technique in which initial 
values are used in the right hand side functions and the six acceler- 
ations are solved for on the left side. The accelerations are then 

* 

used to update the right side functions. A small time increment is 
made and the accelerations are again solved by using the latest 
value for the right side functions. 

With each iteration the accelerations are used in a Taylor 
series expansion to calculate tne velocities. The calculations 
have the form: 




The pitch, roll, and yaw angles are calculated in a similar manner 
using the angular velocity and acceleration. 




In order to plot the trajectory of the submarine, a coordinate 

system transformation is performed to obtain the linear velocities 
• » • 

x b , y Q , z 0 in the fixed coordinate system. The velocities are used 
in a Taylor series expansion to obtain the position of the center of 
gravity of the submarine in the x Q , y Q , z Q system. 
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When the position of the submarine is calculated the time is advanced 
one increment and another iteration begins. 

The iteration loop will continue to operate until some test 
criteria are met. For instance, if the model is performing a dive, 
then the model tests the value of z Q to see if the model is at the 
appropriate depth. A test is also made of the pitch angle to see if 
it is within some specified range of zero. Lastly a check is made to 
ensure that all of the dive planes are at zero deflection. 

II. 4 CONTROL SURFACES 

The motion of the model is controlled by the movement of the 
control surfaces. The control surfaces include the rudder, the 
stem planes, and the sail planes. For analysis of submarine designs 
the movement of the control surfaces can be governed by an automatic 
control system. In the model each control surface is provided with 
its own automatic control system. The principle of operation for 
all of the automatic control systems is the same. In each case the 
deflection of the control surface is made proportional to an error 
signal and the rate of change of the error. The sail planes, for 
instance, control the depth of the model. The calculated deflection 
of the planes is proportional to the depth error and the rate of 
change of depth. 
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8 = K-j (present depth - ordered depth) 

+ l<2 (rate of change of depth) 

A large error will initially cause a large deflection, but as the 
rate of change increases, the deflection will decrease until some 
moderate rate is achieved. Since movement of the sailplanes does 
not have any significant effect on any motion other than depth, 
its control system uses only the variables associated with depth. 

The stern planes control pitch angle as well as depth. The 
control system accounts for this by using the pitch angle, 0, and the 
rate of change of 9 . 

S c = ^3 (P resen t depth - ordered depth) 

+ (rate of change of depth) 

+ K 5 (pitch angle) 

+ Kg (rate of change of pitch angle) 

The K's in the control systems are proportionality constants 
known as gain. The value of the gain determines the sensitivity and 
response of the control system. Since the error signal continually 
varies during a maneuver, it is best to keep the gain low. It is 
desirable to have just enough gain on the error signal to get the 
control system moving and keep it moving in the right direction. 

The gain on the rate signals should be much stronger to dampen out 
the oscillations caused by response to the error signal. 

The control surfaces move at a rate specified by the 
user. Whenever the calculated deflection differs from the 
present deflection, the control surface will move toward 
the calculated value at the specified rate. 
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CHAPTER THREE - PROGRAM USER’S GUIDE 
III. 1 GENERAL FEATURES 

The simulation model consists of a main program and four 
subroutines. The four subroutines are named FUNC, RUDDER, DEPTH, 
and STERN. The main program reads the input data, changes units, 
initializes values, and prints the output. The main program performs 
the Taylor series expansions, the coordinate system transforms, and 
provides the logical statements for calling the subroutines. On the 
first iteration, when time equals zero, no subroutines are called; 
the output from this first iteration is then a statement of the 
initial conditions of the problem. Each succeeding iteration will 
call subroutine FUNC to calculate the new position of the model. 

Calls to the control surface subroutines are made on the basis of 
need, with no subroutine being called more than once in the iteration. 
The decision on whether or not to call RUDDER, DEPTH, or STERN is 
contained in a series of logical IF statements in the main program. 



1 1 1. 2 SUBROUTINE FUNC 



Subroutine FUNC contains the six equations of motion. The 
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input parameters to FUNC consist of the hydrodynamic coefficients, 
the model velocities, the orientation in space, all of the ship's 
characteristics such as length and moments of inertia, the deflection 
of each control surface, and the propulsive coefficients. The sub- 
routine returns the value of the six accelerations: UDT, VDT, WDT, 
PDT, QDT, RDT. The input and output for FUNC are all contained in 
COMMON /FOUR/ and COMMON /FIVE/. The solution to the matrix equation 
in subroutine FUNC is made possible by a call to the library function 
LEQT1F [3]. LEQT1F performs a Gaussian reduction for the matrix 
equation. Any similar Gaussian reduction could be substituted if 
LEQT1F is not available. An explanation of the parameters used in 
the call to LEQT1F is found in Appendix B. 

111. 3 SUBROUTINE RUDDER 

Subroutine RUDDER controls all horizontal motion for the 
model. The input parameters include: K9, K10, T5, T6, Til, T12, 

T17, T18, TLAGR, RRATE, RUDAMT, COURSE, DELR, DELT, R, PSI. The sub- 
routine returns a new value for DELR, the rudder deflection, based on 
a calculation using its present and ordered headings. The inputs are 
all contained in COMMON /THREE/ and COMMON /FIVE/. Subroutine RUDDER 
is called whenever the model is not on the desired course or when the 
rudder is deflected. 

111. 4 SUBROUTINE DEPTH 

Subroutine DEPTH controls the forward set of dive planes. It 
can control either bow planes or sail planes depending on what the 
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submarine is fitted with. This subroutine is sensitive to the depth 
error and the rate of change of depth. Subroutine DEPTH will move 
the forward planes in the direction necessary to bring the depth 
error to zero. As input parameters, the subroutine uses: K1 , K2 

Tl, T2, T13, T14, T15, T16, TLAGB, DELT, DIFF, ADIFF, ZDT, ATHETA, 
MAXANG, DCRIT. The subroutine returns a new value for DELB, the 
bow plane deflection, after each call. 

If MAXANG, the maximum dive/ascent angle, has been exceeded, 
then DEPTH will return a diagnostic write statement. The user may 
specity MAXANG, the maximum pitch angle for the model. Whenever 
MAXANG is exceeded the diving planes are moved to reduce the pitch 
angle and a diagnostic signal is generated from within subroutine 
DEPTH. The diagnostic will say "Maximum dive/ascent angle exceeded 

at time ; . Standard fixup taken." Since the dive planes only 

begin to react when MAXANG is exceeded, the submarine will overshoot 
the angle before a reduction in the angle actually occurs. The 
diving planes will continue to operate until the pitch angle is 
less than MAXANG. 

DEPTH makes only a minimal attempt to control the pitch angle 
of the model; it only warns the user when the angle is exceeded, and 
then moves the bow planes so that the pitch angle does not grow 
larger. The principal purpose of DEPTH is to provide depth control; 
it does this in conjunction with subroutine STERN. 

1 1 1. 5 SUBROUTINE STERN 



Subroutine STERN controls the movement of the stern planes to 
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achieve the desired depth and pitch angle. The movement of the 
planes is sensitive to the depth error, the rate of change of depth, 
the pitch angle, and the rate of change of pitch. The stern planes 
will move to bring the depth error to zero and the pitch angle to 
zero. As input parameters the subroutine uses: K5, K6, K7, K8, T3, 

T7, T8, T10, TLAGS , STERAT, STERMX, THETA, Q, DELS, DIFF, ADIFF, 

ZDT, ATHETA, MAXANG, NOPICH, DCRIT. The subroutine returns a new 
value for the stern plane deflection, DELS. The input and output 
parameters are all contained in COMMON /ONE/, COMMON /FIVE/, and 
COMMON /SIX/. STERN is called to achieve a depth change or to correct 
the pitch angle. 

* 

III. 6 RANGE VARIABLES 

Since it is not usually possible to bring a computer simulation 
model to a precise depth or angle, it is necessary to define ranges 
around the desired depth or artgle which will be acceptable to the 
user. For example, if the submarine were to make a depth change of 
500 feet, the dive may be considered complete if the model settled 
within ten feet of the desired depth. The range is specified by the 
user to enable him to achieve whatever precision is desired. Within 
this range the main program will not make a call to the control sur- 
face subroutine; since no call is made, the control surfaces cannot 
be moved. In the program, the variable name for the depth range is 
NODIFF; it is usually set at + 5 or + 10 feet. Subroutine DEPTH will 
be called whenever the model is off of its ordered depth by more than 
NODIFF. The range about zero pitch angle is given the name NOPICH; 
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it is usually set at + 1 degree. STERN is called if the pitch angle 
is greater than NOPICrl. The variable name for achieving the proper 
course is ONCRS; it is usually set at + 1 degree. RUDDER will be 
called whenever the model is off course by more than ONCRS. 

An additional range variable is used during diving or surfacing. 
When the model moves within some critical range of the desired depth, 
it is time to begin moving the dive planes to zero angle and let the 
vessel glide into the desired depth. This maneuver prevents 
oscillation of the dive planes as the error signal and the rate 
signal both become small. This also ensures that the planes are at 
or near zero angle by the time the desired depth is reached. The 
name of this variable is DCRIT; it is usually set at 50, 75 or 100 
feet depending on the speed of the submarine. STERN will be called 
whenever the model is off its ordered depth by more than DCRIT. 

III. 7 PROGRAM PARAMETERS 

The iterative nature of the program relies on a time increment 
being made after each step. The size of the time increment is 
optional; the smaller the increment the more accurate the calculations. 
In selecting the size of the time increment, one must bear in mind 
the length of time required to complete the maneuver and the storage 
capacity of the program. Due to the quantity of information that is 
calculated by the program, it is practical to print only half of the 
data at one time. The other half of the data is stored in the 

array STOW. This data is then printed when the maneuver is complete. 
STOW has the capacity to hold the data resulting from 600 iterations. 
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A time check is incorporated in the main program to enable the 
user to limit the number of iterations. Achieving a number of 
iterations equal to the variable ICNT will cause the program to stop 
the present maneuver, print out all data, and see if another maneuver 
is desired. ICNT should not be made larger than 600 so that the 
available storage space is not exceeded. 

Each control surface subroutine has a time lag scheme which 
senses the initial command to the control surface and prevents 
immediate action. A time lag occurs each time the direction of 
movement is changed. A different time lag may be specified for 
each control surface. 

The variable INDEX is used to allow the user to perform more 
than one maneuver with a given submarine and then shift submarines 
to perform more maneuvers. If INDEX is less than or equal to zero 
then the same submarine coefficients will be used for each set of 
initial conditions. If INDEX is greater than zero the program will 
read new coefficients as well as a new set of initial conditions. 



25 



CHAPTER FOUR - TEST RESULTS AND CONCLUSIONS 
IV. 1 FUNDAMENTAL MOTION TEST 

The validation of the simulation model is a matter of impor- 
tance. The method used was an independent test of each component of 
the model, and then a series of tests with the components of the 
model working together. The test maneuvers were selected either 
because the correct dynamic response was known or because the maneuver 
was simple enough so that the general nature of the response could 
be predicted. 

The first portion of the model to be tested was the subroutine 
FUNC. FUNC obtains the solution to the six equations of motion. It 
was important to establish that these equations were properly 
installed in the program. A test of subroutine FUNC necessitated a 
simultaneous test of the MAIN program to read in the hydrodynamic 
coefficients, set up the "A" matrix for FUNC, perform the Taylor 
series expansions, and write out the results. The test for FUNC 
was to reduce the 6M of the vessel to zero and then to assume a 
constant angle on the dive planes. If the. model was working cor- 
rectly it should traverse a perfect circle in the vertical plane. 
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It was known that the rudder should not move and the model should 
not roll or yaw. The model should assume a circular trajectory with 
a constant angular velocity and a constant vertical component of 
velocity, w. Figure 3 shows the results of the maneuver. A circular 
trajectory was quickly achieved. The angular velocity was constant, 
w was constant, and the position of the model in the fixed coordinate 
system confirmed the circular path. The model did not roll or yaw 
and the rudder did not move. 

IV. 2 HORIZONTAL MOTION TEST 

With the knowledge that the equations of motion, the Taylor 
series expansions, and the coordinate system transforms are operating 
properly, the subroutine RUDDER was the next component to test. It 
was decided that a simple left turn of 40 degrees would be an 
appropriate test. A left turn was chosen because that presents the 
greatest opportunity for error. The original course would be 000 
degrees true and the new course would be 320 degrees true. Since the 
yaw angle is positive when turning right, the model must cope with a 
negative yaw angle as well as a proper method for dealing with course 
headings given in true bearing. The subroutines DEPTH and STERN were 
rendered inoperative to give the opportunity of seeing RUDDER operate 
without interference. The model would be checked to ensure that the 
proper rudder rate was used and that the rudder angle did not exceed 
the maximum angle ordered. The model would be expected to roll and 
squat in the turn. A change in depth was expected since the dive 
planes could not act. As the model approached the new heading the 
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Simulation Model Trajectory With Constant 
Dive Plane Angle 

Figure 3 
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rudder should be put amidships and the vessel should steady out. 

In Figure 4 the relationship between the rudder and the heading 
is shown as a function of time. The model reacted as predicted 
except possibly at the end of the turn. The rudder' was amidships and 
the new heading was achieved but the program did not run long enough 
to ensure that the model was steady on the course. The model did roll, 
squat, and change depth as predicted. The test for RUDDER was 
considered to be accurate and sufficiently complete to warrant moving 
to the next test. 

IV. 3 VERTICAL MOTION TEST 

* 

Since DEPTH and STERN operate together to regulate the depth 
and pitch of the model, they were tested together. The test consisted 
of a simple dive with a depth change of 700 feet. The course was not 
changed so the rudder should not move. The model should not roll or 
yaw. The dive planes should move in the proper direction and at the 
ordered rate. They should not deflect more than the ordered angle. 

The model should pitch downward and if the maximum ordered pitch 
angle is exceeded then the dive planes should move to reduce the 
pitch angle. As it approaches the desired depth, the model should 
slow its rate of descent and settle within ten feet of the depth, 
with 0 -1 degree of pitch angle. 

The trajectory for this test is shown in Figure 5. The model 
achieved steady state only six feet beyond the desired depth; the 
pitch angle was -.03 degrees. The dive planes were all at zero 
deflection. The model stayed within ten feet of the ordered depth 
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and within one degree of zero pitch angle for twenty seconds. This 
was done to ensure that a steady state had been achieved. 

IV. 4 COMPLETE MODEL TEST 

As a final test the entire simulation model must work together. 
This test repeated the forty degree left hand turn but this time the 
dive planes were allowed to react to try to maintain the depth. The 
program was kept running until the pitch angle was within one degree 
of being zero, the model was within one degree of the proper course 
and the depth was within ten feet of the ordered depth. The model 
was initialized on course 000 degrees true at an initial speed of 
twenty knots. 

The maneuver was successfully completed. The model remained 
steady at 320 -1 degrees true and the final depth was within one 
foot of the ordered depth. Both the pitch and roll angles were near 
one degree and were decreasing in magnitude. All of the control 
surfaces were at zero angle of deflection. It should be noted that 
the new course had been achieved during the first sixty seconds and 
that the course was maintained by the model while the proper depth 
and attitude were being obtained. 



IV. 5 USE AS A DESIGN TOOL 

There are numerous design tasks that could be used to demonstrate 
the simulation model; a simple example is sufficient for this demon- 
stration. Suppose a designer wanted to know the dynamic effects of 
increasing the rudder rate in a turn. The designer would elect to 
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use a simulation model. Since he would not want the dive planes to 
interfere with the analysis, he would set NODIFF, DCRIT, and NOPICH 
at large values so that the dive planes would not move. Then he 
would set RRATE, the rudder rate, at the value he desired to test 
and order the model to come to a new course. For this run, let's 
assume that the designer performed the left hand turn from 000 
degrees true to 320 degrees true. He used a rudder rate of two 
degrees/second. He then caused the model to perform the same 
manuever again with a new rudder rate of four degrees/second. With 
the output from these two maneuvers he could easily find the time 
required for the turn, the advance and transfer of the submarine, 
and the roll and pitch angles as a function of time. The designer 
could use the information for whatever analysis he had in mind. The 
model could be run again -at new rudder rates or the dive planes could 
be brought into play or virtually any other maneuver could be 
simulated. This model can also do snap roll analysis [4]. 

The cost of running the simulation model is so low that it can 
be used on a daily basis if desired. For the test turns mentioned 
above, the cost was less than five dollars, which included reading 
the cards, compilation, execution, and 900 lines of output. A 
designer who used the model regularly could have the model as an on 
line dataset which would greatly reduce the cost of using the model. 

IV. 6 CONCLUSIONS AND RECOMMENDATIONS 

This simulation model does accurately simulate the six degree 
of freedom motion of a submarine for moderate maneuvers. The cost of 
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operating the model is very low, which will allow frequent usage. 

The model is designed to permit a great deal of flexibility in the 
application of the model. For those designers who use the simulation 
model, it should be a useful design tool. 

If work were continued on this simulation model, it is recom- 
mended that some time be spent in improving the appendage control 
subroutines. Further application of control theory would be helpful 
with the appendage subroutines. The data input could be organized 
more efficiently to remove some of the opportunity for error. It 
could be very useful to have a plotting routine in the model to 
visually display the information. 
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A.l NOTATION 



Symbol 



Dimensionless Form 



Definition 



B 



B* = 



B 



Buoyancy force, positive upward 



CB 

CG 

I 



xy 



l x 

I ' = — — 
x ipi* 



V = 

I '= — - 2 
2 

_ Ixy 

xy ~* p <, s 



I 



y* 



K 



K, 






K 



K. 

P 



K 



plpl 



pq 



i « = -l*. 2 . 

v 2 ip4 6 



i 



K 



Jzx 
2X fP^° 

K 



3 r r2 



£p-t 3 u 

K ■- K * 

* "f P 4 3 U* 

k* • = . K ?n 



n t?-c 3 u* 
k • = — ^2_ 

p %pl*V 
p ?p* 6 



K 



K_ 



plp| ipe 



K r 



k • = — Pg - 

P<1 spt 6 



Center ox buoyancy of submarine 
Center of mass of submarine 

Moment of inertia of submarine about x axis 
Moment of inertia of submarine about y axis 
Moment of inertia of submarine about z axis 
Product of inertia about xy axis 
Product of inertia about yz axes 
Product of inertia about zx axes 



Hydrodynamic moment component about x 
axis (rolling moment) 

Rolling moment when body angle {ry, 8 ) and 
control surface angles are zero 



Coefficient used in representing as a 
function of (77- 1) 



First order coefficient used in representing 
K as a function of p 

Coefficient used in representing K as a function 
of- p 

Second order coefficient used in representing 
K as a function of p 

Coefficient used in representing K as a function 
of the product pq 
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K 

qr 


K 1 
q r 


JSsl. 

ieS 


Coefficient used in representing K as a 
function of the product qr 


K 

r 


K ’ 
r 


K r 

?pt 4 U 


First order coefficient used in representing 
K as a function of r 


K* 

r 


K« * 
r 


K f 

tpl 6 


Coefficient used in representing K as a 
function of r 


K 

V 


K ' 

V 


K v 

' £pt 3 u 


First order coefficient used in representing 
K as a function of v 


K. 

V 


K.' 

V 


ip<- 4 


Coefficient used in representing K as a 
function of v 


< 

< 


K , 

, v|i 


, K v|v| 

'1 -JZ7- 


Second order coefficient used in representing 
K as a function of v 


K 

vq 


K 1 
vq 


K vq 
" £p<- 4 


Coefficient used in representing K as a function 
of the product vq 


K 

vw 


K 

vw 


, _ ^vw 
jpt 3 


Coefficient used in representing K as a function 
of the product vw 


K 

wp 


K 

wp 


. - *wp 
fcp-t 4 


Coefficient used in representing K as a function 
of the product wp 


K 

wr 


K 

wr 


Kwr 

tP-C. 4 


Coefficient used in representing K as a function 
of the product wr 


K. 

6 r 


K. 1 
6r 


*6r 

"jpt 3 U J 


First order coefficient used in representing 
K as a function of 6 r 


l 


V = 


1 


Overall length of submarine 




m' = 


m 


Mass of submarine, including water in free- 
flooding spaces 




ip* 3 


M 


M 1 = 


M 


Hydrodynamic moment component about y axis 
(pitching moment) 


ip 4 3 U* 






Mi 

£o 4 3 U* 


Pitching moment when body angles (or, 5 ) and 
control surface angles are zero 


M 

PP 


M 

PP 


M PP 

SP-t 


Second order coefficient used in representing 
M as a function of p. First order coefficient is 






= J£a_ 

SP^ 4 U 


zero. 


M 

q 


M ' 

q 


First order coefficient used m representing 
M as a function of q 


M qr? 


m : 
qn 


, . Mql 
' iptnT 


First order coefficient used in representing 
as a function of (T7-I) 


M. 

q 


M.' 

q 


= T Mi 
SP* 5 


Coefficient used i-n representing M as a 
function of q 
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M 



q|q| 



M 



M 



q|q| 






Second order coefficient used in representing 
M a3 a function of q 



M. lit 

I q| fis 



M, 



q| 6s 



M |q|&s 

*pl 4 U 



Coefficient used in representing g as a 
function q 



M 



r P 



M 



M 



IP 



rp sp 4 s 



Coefficient used in representing M as a 
function of the product rp 



M 



M rr 

M ' = rr 
rr 






M 



vp 



M 1 



vp 



Myp 



Second order coefficient used in representing 
M as a function of r. First order coefficient 
is zero 

Coefficient used in representing M as a 
function of the product vp 



M 



vr 



M • 



vr 



M vr 

iP't 4 



Coefficient used in representing M as a 
function of the product vr 



M 



vv 



M 



M v , 

ip ^ 3 



Second order coefficient used in representing 
M as a function of v 



M 



w 



M 1 = 



w 



Mw 

$pt 3 U 



First order coefficient used in representing 
M as a function of w 



M 



WTJ 



M 



M., 



WT 7 



tP<. 3 U 



First order coefficient used i'n representing 
M w as a function of ^ 



M. 



w 



M 



M 



Mw 

tp 6 * 



M 



M[ w [ 

Jp 4 3 U 



M. 



w|q 





Coefficient used in representing M as a function 
of w 

First order coefficient used in representing M 
as a function of \v; equal to zero for symmetrical 
function 

Coefficient used in representing M q as a function 
of w 



M 



w w 



M 



Mw |w | 
?p-C 3 



Second order coefficient used in representing 
M as a function of w 



M 



w | w 1 77 



M 

ww 



M 



w|w 1 77 = 



M, 



M ' = 

ww 



Ip^ 

Mww 



w |w f 77 



M 



6 b 



M 



6b 



Mfrb 

jpi 3 U 2 



First order coefficient used in representing 

M . , as a function of (17-I) 

w| w | ' 

Second order coefficient used in representing 
M as a function of w; equal to zero for sym- 
metrical function 

First order coefficient used in representing 
M as a function of 6, 



M 



6 s 



M 



6s 



m 5s 

2 P 4 3 U 2 



First order coefficient used in representing 
M as a function of 6 s 



M 



6stj 



M • = M6st > 

5 s 77 U 4 



First order Coefficient used in representing 
M^ s as a function of (77- l) 



38 



N 



N' 



N 

ipI^U 2 



Hydrodynamic moment component about z 
axis (yawing moment) 



N* 



N*’ = 



N* 

ipFTP 



Yawing moment when body angles (or. £) and 
control surface angles are zero 



N 

P 



N ' 
P 



IpFTT 



First order coefficient used in representing N 
as a function of p 



N. 

P 



N- 

N.’ = - — 

p ip-t s 



N 



- N PP 

pq ipt 5 



Coefficient used in representing N as a function 
of p 

Coefficient used in representing N as a function 
of the product pq 



N 



qr 



N 



N, 



q r 



q r 






Coefficient used in representing N as a function 
of the product qr 



N 



r 



N ' = 



5P4-*U 



First order coefficient used in representing N 
as a function of r 



N 



*V 



N 



N. 



rr ? 



r v ~ JpZmj 



First order coefficient used in representing 
N P as a function of ( 77 - 1 ) 



N. 



r 




Coefficient used in representing N as a function 
of r 



N 



r 1 r 1 



N 




Second order coefficient used in representing 
N as a function of r 



N 



| r I 6r 



N 



I r| 6r 



N| r 1 6r 

ipl*U 



Coefficient used in representing as a 

function of r 



N 

V 


N ' 

V 


N v 


'*P-t 3 U 


N 

vp 


N ' 

VTJ 


, . N vr, 




N. 

V 


N. ’ 

V 


Ny 




N 


N 1 


, . N vc , 


vq 


vq 


§P<- 4 



First order coefficient used in representing N 
as a function of v 

First order coefficient used in representing N v 
as a function of (q-l) 

Coefficient used in representing N as a 
function of v 

Coefficient used in representing N as a function 
of the product vq 



N, 



vlr 



N 



, _ N|vli 

M r " *p-t 4 



Coefficient used in representing N r as a 
function of v 



N 



v|v| 



N , ' = 

v| v| 






M 



SP* 3 



Second order coefficient used in representing 
N as a function of v 



N , , 

v| v|tj 



N 



v| v|jj 



Ny I v I T) 



First order coefficient used in representing 
I^vjvl 33 a function of ( 77- i ) 
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N 

vw 


JkJ 1 _ N VW 

vw " sp** 


Coefficient used in representing N as a function 
of the product v\v 


N 

wp 


nj _ 

ii 

a>M 


Coefficient used in representing N as a function 
of the product wp 


N 

wr 


N • = N ' vr 
wr % p t* 


Coefficient used in representing N as a function 
of the product wr 


N 6r 


N 1 = — ■ . 

6r ^p4 3 U" 


First order coefficient used in representing N 
as a function of 6 r 


N 6t V 


jv» » - N 6rrj 

6rJ I -|pt 3 u z 


First order coefficient used in representing 
N^ r as a function of (77- 1) 


P 


p'-# 


Angular velocity component about \ axis 
relative to flu'd (roll) 


F 


p.=*L 

* U 2 


Angular acceleration component about x axis 
relative to fluid 


q 


q' = -al 

4 u 


Angular velocity component about y axis relative 
to fluid (pitch) 


q 


4 ir 


Angular acceleration component about y axis 
relative to fluid 


r 


II 


Angular velocity component about z axis 
relative to fluid (yaw) 


r 


• » - H 2 
" TF" 


Angular acceleration component about z axis 
relative to fluid 


U 


u-.IL . 
u 


Linear velocity of origin of body axes relative 
to fluid 


u 


*'= J t 


Component of U in direction of the x axis 


U 


fi' = ii 


Time rajte of change of u in direction of the 
x axis 


u c 


l U C 

c U 


Command speed: steady value of ahead speed 
component u for a given propeller rpm when 
body angles (a, ft) in d control surface angles 
are zero. Sign changes with propeller reversal 


V 


v' = Jl 
U 


Component of U in direction of the y axis 


V 


<• 

ii 

c \S 

N | 


Time rate of change of v in direction of the 
y axis 
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w 


•I s 

ii 

> 


Component of CJ in direction of the z axis 


w 


^ _ vC4 

U 2 


Time rate of change of w in direction of the 
z axis 


W 


W= w , , 

spt'u* 


Weight, including water in free flooding spaces 


X 


, _ X 

4 


Longitudinal body axis; also the coordinate cf a 
point relative to the origin of body axes 


X B 


x ' = 

B 4. 


The x coordinate of CB 


X G 


„ , X G 


The x coordinate of CG 


x o 


x°h 

u 

K° 


A coordinate of the displacement of CG relative 
to the origin of a set of fixed axes 


X 


Y •» 

X' = -■ --V -2 
SP4 2 U* 


Hydrodynamic force component along x axis 
(longitudinal, or axial, force) 


X 

qq 


v i _ x qq 
qq “ ^p4“ 


Second order coefficient used in representing 
X as a function of q. First order coefficient 






is zero 


X 

rp 


X • = 
r P £pt* 


Coefficient used in representing X as a function 
of the product rp 


X 

rr 


x„ 

X ' = -T-4I-- 
rr 


Second order coefficient used in representing 
X as a function of r. First order coefficient is 






zero 


X. 

u 


X* 

X U = ipZ 3- 


Coefficient used in representing X as a function 
of u 


X 

uu 


x • = iSiu. 
uu tel 1 


Second order coefficient used in representing 
X as a function of u in the non-propelled case. 
First order coefficient is zero 


X 

vr 


x VP 

V 1 _ v * 

vr " ipi 3 


Coefficient used in representing X as a function 
of the product vr 


X 

vv 


X • - X vv 
w Jp-C* 


Second order coeffient used in representing X 
as a function of v. First order coefficient is zero 


X 

VV 77 


, _ X VVT? 

VV T) 


First order coefficient used in representing X vv 
as a function of ( 77 -!) 


X 

wq 


v • _ X wq 
wq * 


Coefficient used in representing X as a function 
of the product wq 
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X ww 

X * V-TJ 


v , _ ^ww 

ww ~ 

x ■ = 5^ 
ww i? 


Second order coefficient used in representing 
X as a function of w. 'First order coefficient is 
zero 

First order coefficient used in representing X ww 
as a function of ( 77 - 1) 


X 6b6b 

X. , 
6r6r 


v , X 6b6b 

6b6b " | p t 2 U 2 

v i _ 6r 5r 

6r6r “ % p i z U z 


Second order coefficient used in representing X 
as a function of 6^,. First order coefficient 
is zero 

Second order coefficient used in representing 

X as a function of 6 r . First order coefficient is 
zero 


X 6r6r rj 


v- i _ ^6r6r77 

6r6rrj -|p-t 2 U 2 


First order coefficient used in representing 
^6r6r as a notion of { 77 - 1 ) 


X 6a6s 


v i _ X 6s6s 

6s6s 


Second order coefficient used in representing X 
as a function of 6 S . First order coefficient is 
zero 


x, 

6s6s7j 


v i _ ^6s6s?) 

6s6stj " | P 4 2 u 2 


First order coefficient used in representing 
X. . as a function of (77-1) 


r 


II 


Lateral body axis; also the coordinate of a 
point relative to the origin of body axes 


y B 


y B = — 


The y coordinate of CB 


y G 


. y c 

y G = — 


The y coordinate of CG 


o 

\ 


0 _ 

II 

Ho" 


A coordinate of the displacement of CG relative 
to the origin of a set of fixed axes 


Y 


v, - Y 

i^tTu 2 


Hydrodynamic force component along y axis 
(lateral force) 


Y* 


Y " ‘ip^u 2 


Lateral force when body angles (a, £) and control 
surface angles are zero 


Y 

P 


Y .= Y p 

P £p-t, 3 u 


First order coefficient used in representing 
Y as a function of p 


Y. 

P 


Y P ~ £p-t 4 


Coefficient used in representing Y as a function 
of p 


Y plpl 


y ■ _ Y PIP| 

PIP 1 ” |p4 4 


Second order coefficient used in representing 
Y as a function of p 
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Y pq 


Y ’ : 

pq 


= J.pq. 

tpt 4 


Coefficient used in representing Y as a function 
of the product pq 


V 


Y * = 

qr 


s pi* 


Coefficient used in representing Y as a function 
of the product qr 


v 


Y ' - 


Y r 


First order coefficient used in representing Y - 
as a function of r 


r 


1 r 




Y rn 


Y 1 : 
TT 7 


FpFu 


First order coefficient used in representing 
Y r as a function of (77- l) 


V 


Y. 1 - 


Yf 


Coefficient used in representing Y as a function 
of f 


I • 
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r 


^p 4 4 


Y |rl6r 


V , _ r 1 6r 

1 r| 5 r ” U 


Coefficient used in representing Y^ as a 
function of r 


Y 


Y * - 


Y v 


First order coefficient used in representing 
Y as a function of v 


X 

V 


Y v " 




Y vt? 

Y. 

V 


Y 1 

VT) 

Y.’ = 

V 


Yvt, 

•^pt i U 

Y* 


First order coefficient used in representing 
Y y as a function of (77- 1 ) 

Coefficient used in representing Y as a 
function of v ^ 


Y 

vq 


Y 1 

vq 


- 1 ^ 


Coefficient used in representing Y as a function 
of the product vq 


Y v.r| 


Y v 1 r 


, Y v | r | 

1 = w 


Coefficient used in representing Y v as a function 
of r 


Y v|vl 


Y v | v 


, _ Y v |v| 

i -~&r 


Second order coefficient used in representing 
Y as a function of v 


Y vIv|tj 


Y vjv 


, _ Y v 1 v| TJ 

1 TJ jpt* 


First order coefficient used in representing 
Y v | y | as a function of (77- i) 


Y 

vw 


Y ' 

vw 


. ^ 
" fpt* 


Coefficient used in representing Y as a 
function of the product vw 


Y 

wp 


Y • 

wp 


. Y wp 

fpt 3 


Coefficient used in representing Y as a 
function of the product wp 


Y 

wr 


Y ' 
w r 


Y 

_ wr 

jpt 3 


Coefficient used in representing Y as a 
function of the product wr 


Y 5r 


Y. ’ 
6r 


Y 6r 


First order coefficient used in representing 
Y as a function of 6r 


Y 6rrj . 


Y 

6r 7 ? 


. . Y 6rt, 


First order coefficient used in representing 
Y as a function of (77- l) 
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Z B 

Z G 




Normal body axis; also the coordinate of a 
point ’relative to the origin of body axes 

The z coordinate of CB 

The z coordinate of CG 



A coordinate of the displacement of CG 
relative to the origin of a set of fixed axes 



Z 




Z 

q 



Z 1 = 



Z*’ « 



z* 






Z ' = -~PP 
PP £p 4 * 



z • . -£a__ 

4 *p<, 3 U 



Hydrodynamic force component along z 
axis (normal force) 

Normal force when body angles (a. £) and 
control surface angles are zero 



Second order coefficient used in representing 
Z as a function of p. First order coefficient 
is zero 

First order coefficient used in representing 
Z as a functicn of q 
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First order coefficient used in representing 
Zq as a function of (77- 1 ) 

Coefficient used in representing Z as a 
function of q 
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Coefficient used in representing Z^ as a 
function of q 
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Z 1 



r P 




Coefficient used in representing Z as a 
function of the product rp 
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rr 




Second order coefficient used in representing 
Z as a function of r. First order coefficient 
is zero 
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Zw 



First order coefficient used in representing 
Z as a function of w 
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First order coefficient used in representing 
Z w as a function of (77- 1 ) 
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Coefficient used in representing Z as a 
function of w 
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First order coefficient used in representing 
Z as a function of w; equal to zero for sym- 
metrical function 



Z w|q| 



Z w!q|' 
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Coefficient used in representing Z as a 
function of q 
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Second order coefficient used in representing 
Z as a function of w 

First order coefficient used in representing 
Z , , as a function of (t]- 1 ) 

W [ W I I 

Second order coefficient used in representing - 
Z as a function of w; equal to zero for sym- 
metrical function 

First order coefficient used in representing Z 
as a function of 6^ 

First order coefficient used in representing 
Z as a function of 6 g 

First order coefficient used in representing 

Z- as a function of (77- 1) 
os 

Angle of attack 
Angle of drift 

Deflection of bowplane or sailplane 
Deflection of rudder 

Deflection of sternplane 
u c 

The ratio 
Angle of pitch 
Angle of yaw 
Angle of roll 



a., b.. 
i # l' 



c. 

1 



Sets of constants used in the representation of 
propeller thrust in the axial equation 



A. 2 EQUATIONS OF MOTION 
AXIALi FORCE 



m £u - vr + wq - Xq (q 3 + r 2 ) + (pq - r) + (pr + 



+ — l* |"x ' q 2 + X r ' r 2 + X ' rp ] 

2 L qq M rr rp r J 

+ i 3 |"x- ' u + X ' vr + X ' wq 1 
2 . L u vr wq J 



f * 2 [ 



X ' u 2 + X ' v 2 + X ' w 2 1 

MM VV WW J 



+ r 5r2+X 6s 6s' ' 6s2+X 6b6b 

+ t p-t 2 a. u 2 + b. uu + c. a 2 j 
4 r L i ic icj 



- (W - B) sin 0 



f‘ 2 [ 



X • v 3 + X ' w 3 + X 



vv7} 



WWT} 



. . ' 6 2 a 3 

SrOrl? r 



+ X 5s6s^ 5 s 2 “’.J 
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LATERAL FORCE 



m[v - wp + ur - y G (r 3 + p 8 ) + z Q (qr - p) + x G (qp + r) J = 

+-2- T Y* ' r + Y. ' p + Y , ,'plpl+Y ' pq + Y ' qrl 
2 L r p r PP pq qr H J 



+-£- X 3 [ Y-' v + Y ' vq + Y ' wp + Y ' wr 1 

2 L v . vq ^ wp r wr J 

+ f * 3 [V" r+ V UP + Y |r| 6 r' u l r l 6r + Y v l r| , |T 1 l< v2+ '" 2 > i 

+T ? [v Vi 2 + Y y - uvt Y y | v .|' v |(v 3 + w 2 ) Y |] 



^ [ 



Y ' vw + Y ' 
vw or 



u 3 6rJ 



+ (W - B) cos 9 sin <|> 



+ f * 3 - Y r„’ “ r <"- 1 ) 



i [ Y W,' uv + Y v|v|V v|(v * + wS)i l + Y 6 r n , V u3 ']t I >-i> 
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NORMAL FORCE 



. i 



m[w - uq + vp - z Q (p 2 + q 2 ) + x Q (rp - k) + V G < rc l + p) J = 

*± i 4 [z^ q + V P 2 +Z rr ' r2 + V *»] 

+ — X 3 [v w + Z vr ' vr + Z vp ' vp] 



+ a|ql 6 s + Z^,' « |(v 2 + w 2 ) 2 | |q|j 



|q| 6 s 



+— x 3 [z ' - 

2 L <1 

i 2 [z ; 1 u 3 + Z w ' uw + z wlwl - w|(v a + W 2 )M] 



2 . ,„2 



* 2 [ z |wf u l w l + z ww' ' w (v2 + w 2 ) 2 l] 

« 

-_P- i 2 [z vv ‘ V 2 + Z* J U 2 6 s + Z AK ' a 2 - 6 b] 



+ (W - B) cos 0 cos <t> 



+ V uq (,, - 1) 



i i2 [ 



Z ' uw + Z 
wTJ w 



| w |„' wllv 2 +w=) 2 | + Z 6sn '6 s a 2 j(n- 



1 ) 
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ROLLING MOMENT 



I p + (I - I ) qr - (r + pq) I + (r - q ) I + (pr - q) I 

x r z y n rn ' xz n yz xy 

+ m ^y G (w - uq + vp ) - z^ (v - wp + ur) J = 



+JL 


i s i k- 1 


1 p + K- 1 


1 r + K ' 


2 


L p 


r r 


q r 


+ | 


l *\ K ' 


up + K ' 


' ur + K' 1 


2 


L P 


r 


V 


H — — 
2 


^ [ K vq 


' vq + K 


1 wp + £ 
wp . r 


+-£. 

7 


* 3 [ K * 


' u 2 + K 


• uv + K 

V V 



P IP I 



+— l 3 f-K 'vw + K. ' 
2 L. vw 6r 



u 2 6r] 



+ (y^ W - y^ B) cos 0 cos - (z^.W - z^B) cos 0 sin <t> 1 



+ 2 ^ K *V (1-D 
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PITCHING MOMENT 



I q + (I - I ) rp - (p + qr) I + (p - r 2 ) I + (qp - r) I 
y ^ x z r r ^ xy ^ zx nr yz 



+ m 



[z G (a - vr + wq) - (w - aq + vp) j = 

+-£■ X 5 Fm* 1 q + M 1 p 2 + M 1 r 2 + M 1 rp + M i i 1 
2 L. q H pp y rr rp q|q| 



q|q|] 



, p 4 r i 

+-T- l jM-'w + M 1 vr + M 'vp 
2 L w vr vp r J 



r i -| 

+ 2 £ L M q' Uq + M Jq| 6s' u l < ll 6s + M |w|q + M 



+_£. X 3 jM ' u 2 + M ' uw + M | | 

2 L * w w j w | 



w 



I (v 2 + w 2 ) 2 1 J 



+ — [ M | w j' U l w l + M ww ' l w (v 3 + W 2 ) 2 I J 

+ Y * 3 [ M vv ' v " + M 6s' u2 6s + M 6b' u2 - 6b J 
- (x_ W - x R B) cos 0 cos <t> - (z G W - z R B) sin 0 



+ -2. -t 4 M 1 uq (1?-1) 

2 q 7 ) 



i t3 [ 



M ' uw 
wTJ 



+ M w |w|n' w|(v3+ w2>51 + M t>sn W'” 
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YAWING MOMENT 

I r + (I - I ) pq - (q + rp) I + (q 2 - p 2 ) I + (rq - p) I 
z y x r 1 M v ‘ yz M v xy n r zx 

r . -i 

+ m [_Xq (v - wp + ur) - y^, (u - vr + wq) J,= 

+— l S l~N- • r + N- 1 p •+ N ’ pq + N ' qr + N . I'rlrll 
2 Ur P pq q r r I r I 1 J 

♦ 

+ i 4 | N* 1 v + N 1 wr + N * wp + N * vq I 

2 L v wr wp vq ^ J 

+ 2f i4 [ N p' Up + N r' Ur + N |rl6r' u l r l 6r + N | v |r' ^ + w 2 ) 2 |r] 

• » ' 

[v U 2 + N v ' uv + N v j v j' V |(v 2 + w 2 ) 2 |] 






+ 4- Wn ' vw + N £ ' u 2 fir "] 
2 L v # w Or J 



+ ( X( -, W - Xg B) cos 0 sin <t> + (y^, W -y^ B) sin 0* 



+ •2- -C 4 N ' ur ( 17 - 1 ) 

2 rtj 

+ _ 2 ^ 3 [ N vT7' uv + N v|v|rj' v l (v2 + w3)1 \ + N 6rTj' 6 r u3 ] (t? ‘ 1) 
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A. 3 AXIS TRANSFORMATIONS [2] 

1) A transformation of an axes system takes a quantity described 
in one frame of reference and transforms it into another frame of 
reference such that if we measured the same quantity in the second 
frame of reference the transformed quantity and the measured quantity 
would be identical. 

2) Transforms between frames are needed in the study of the motions 

of ocean vehicles because the equations of motion for such a vehicle 

are most easily derived in the inertial frame attached to the earth 

(x , y„ , zj frame, while the forces acting on the vehicle are most 
0 0 0 

easily evaluated in the frame attached to the vehicle (x, y, z). 

Hence, we ultimately desire to transform the equations of motion 
from the inertial frame into the non- inertial frame fixed in the 
vehicle. 

> > 

3) If V is some vector measure in the x„ , y„ , z„ frame and V 

some vector measured in the x, y, z frame which is only changed 
in orientation then: 



V » T U, <?,*) V Q where T { I* , d , 4>) - the transform. 



Where 



cos<? cos^ 



T (<£, 0, $ ) = -sin>A cos <t> + sin <i> sin<? cos^ 

sin <t> sin<A + cos <£ cos<A sin# 



cos 9 sin^ 



-sin e 



cost cds f + sin<£ sin 9 sinf 



sin <f> cose 



-sin</> cos^ + cos<A sin# sin^ 



cos<A cos# 
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4) If V Q and V are the same vectors as in (3) above, then: 
V Q = T' 1 (*,8,* ) V 

Where 

T ^ ( </>, 0 , ^ ) = 

cos0 cos^ -sin^ cos</> + sin<£ sin0 cost 

cos 9 sinf cos <f> cos <f> + sin</> sin0 sin^ 

-sin0 sin^> cos0 

sin^ sin«A + cos <t> cos f sin 0 
-sin^ cos 4* + cos <f> sin0 sinf 
cos <t> COS0 
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B.l LIST 

VARIABLE 

A 

AA 

A1.A2 

AI.BI.CI 

B 

BORATE 

BOWMAX 

COURSE 

DECRIT 

DELI 



APPENDIX B 



OF VARIABLES 



MEANING 



Six by six matrix containing coefficients 
Of UDT, VDT, WDT, PDT, QDT, RDT. 

Six by six matrix set equal to matrix A 
before each call to FUNC. The values of 
AA are lost in the matrix reduction performed 
by LEQT1F. 

Limits used for selecting the proper 
propeller thrust. 

Set of constants representing the propeller 
thrust in the X-equation. 

Ship's buoyancy. 

Average bowplane rate. 

Maximum ordered bowplane deflection. 

New course for the ship. 

Value of depth error when dive planes are 
returned to zero deflection. 

Calculated deflection of the bowplane. 



DEL3 



Calculated deflection of the stern plane. 
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DEL4 

DELB 

DELBO 

DELGM 

DELR 

DELRO 

DELS 

DELSO 

DELT 



Calculated deflection of the rudder. 

Actual bowplane deflection at time t. 

Actual bowplane deflection (units changed 
for output). 

Amount the original GM is to be changed. 

Actual rudder deflection at time t. 

Actual rudder deflection (units changed 
for output). 

Actual stern plane deflection at time t. 

Actual stern plane deflection (units 
changed for output). 

Time increment used in iteration. 



DIFF Difference between present depth and 

ordered depth. 

E Six by one matrix containing solution to 

right hand side of equations of motion. 

ICNT Counter used to count the number of 

iterations 

ID Forty-character alphanumeric heading. 

INDEX If greater than zero, read new submarine 

coefficients. If less than or equal to 
zero, run same submarine for new initial 
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conditions. 


IX,IY,IZ,IXY,IXZ,IYZ 


Moments of inertia. 


KCOEFF 


K - equation coefficients: 


L 


Ship's overall length. 


LEQT1F 


Matrix reduction subroutine from IMSLIB [3] 


M 


Ship's mass. 


MAXANG 


Maximum ordered dive/ascent angle. 


MCOEFF 


M - equation coefficients. 


NCOEFF 


N - equation coefficients. 


NODIFF 


Acceptable error range around ordered depth 


NOPICH 


Acceptable error range around zero pitch 
angle. 


ODEPTH 


Ordered depth. 


ONCRS 


Acceptable error range around ordered 
course. 


P»Q»R 


Angular velocity about the x, y, and z 
axes respectively. 


PDT,QDT,RDT 


Angular acceleration about the x, y, and z 
axes respectively. 


PDTO,QDTO,RDTO 


Angular acceleration about the x, y, and z 
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axes, respectively (with units changed for 
output). 


PHI 


Angle of roll . 

¥ 


PHIO 


Angle of roll (with units changed for 
output). 


PO,QO,RO 


Angular velocity about the x, y, and z 
axes respectively (with units changed for 
output). 


PSI 


Angle of yaw. 


PSIO 


Angle of yaw (with units changed for 
output). 


RHO 


Sea water density. 


RRATE 


Average rudder rate. 


RUDAMT 


Maximum ordered rudder deflection. 


STERAT 


Average stem plane rate. 


STERWX 


Maximum ordered stern plane deflection. 


STOW 


Storage array for half of output data. 


T 


Present time. 


T1 . . . T18 


Time lag signals. 


THETA 


Angle of pitch. 
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THETAO 


Angle of pitch (with units changed for 
output). 


TLAGB 


Time lag for bowplane control system. 


TLAGR 


Time lag for the rudder control system. 


TLAGS 


Time lag for stern plane control system. 


u,v,w 


Forward, lateral, and vertical velocities 
respectively. 


UDT,VDT,WDT 


Forward, lateral, and vertical accelerations 
respectively (with units changed for output). 


UO 


Initial forward velocity. 


UOO,VO,WO 


Forward, lateral, and vertical velocities 
respectively (with units changed for output). 


WT 


Ship's weight. 


X,Y,Z 


Coordinate labels of the fixed (x Q , y Q , 
z Q ) coordinate system. 


XB,YB,ZB 


The x, y, z position of the center of 
buoyancy. 


XCOEFF 


X - equation coefficients 


XDT,YDT,ZDT 


Velocities in the fixed coordinate system 
along the x Q , y , z Q axes respectively. 


XG,YG,ZG 


The x, y, z position of the center of 



gravity. 



YCOEFF 



Y - equation coefficients 



ZCOEFF 



Z - equation coefficients 
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B.2 COMPUTER PROGRAM LISTING 
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IF( (CRS2.GT.0NCRS).0R. (DELR.NE.O. ) ) CALL RUDDER 
17 IF(ADIFF.GT.NODIFF) CALL DEPTH 
IF(ADIFF.GT.DCRIT) CALL STERN 

IF( (ADIFF.LT.DCRIT). AND. (ATHETA.GT. NOPITCH)) CALL STERN 



CONVERT ANGLES IN RADIANS TO DEGREES AND FT/SEC TO KNOTS FOR OUTPUT 
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B.3 LEQT1F 

A - input matrix of dimension N by N containing the coefficient 

0 

matrix of the equation AX = B. 

On output, A is replaced by the LU decomposition of a 
rowwise permutation of A. 

M - number of right-hand sides, (input) 

N - order of A and number of rows in B. (input) 

IA - number of rows in the dimension statement for A and B in 

the calling program, (input) 

B - input matrix of dimension N by M containing right-hand 

sides of the equation AX = B. 

On output, the N by M solution X replaces B. 

IDGT - input option. 

If IDGT is greater than 0 the elements of A and B are 
assumed to be correct to IDGT Decimal digits and the 
routine performs an accuracy test. 

If IDGT equals zero, the accuracy test is bypassed. 

WKAREA - work area of dimension greater than or equal to N. 

IER - error parameter 

terminal error = 128 + N 

N = 1 indicates that A is algorithmically singular. 

Warning error = 32 + N. 

N = 2 indicates that the accuracy test failed. The 
computed solution may be in error by more than can be 
accounted for by the uncertainty of the data. 

CALL LEQT1F (A, M, N, IA, B, IDGT, WKAREA, IER) 
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